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FOREWORD 


This  document  contains  the  first  subset  of  equations 
to  be  furnished  to  the  Defense  Mapping  Agency  Aerospace 
Center  (DMAAC)  as  a part  of  Task  II  of  contract  DMA700- 
74-C-0075,  "Aided  Inertial  Navigation  System  Error  Analysis." 
A total  of  three  such  equation  subsets  will  be  issued: 

1.  Free-Inertial  and  Damped-Inertial  Navigation 
Mechanization  and  Error  Equations  (the  present 
report) 

2.  Covariance  Propagation  Equations  for  Optimal 
and  Suboptimal  Kalman-Filter-Integrated  Multi- 
Sensor  Inertial  Systems 

3.  Models  for  Aided  Inertial  Navigation  Instrument 
Errors 

The  intent  of  these  equation  subsets  is  to  provide 
DMAAC  with  complete,  self-contained  mathematical  "modules" 
suitable  for  studying  modern  multi-sensor  inertial  navigation 
systems  such  as  those  of  the  B-1  and  F-15  aircraft.  These 
subsets  of  equations  are  rendered  in  a form  sufficiently  general 
as  to  be  applicable  to  the  inertial  systems  in  all  terrestrial 
vehicles.  Included  in  this  category  are  missile,  aircraft  and 
marine  navigation.  Also  detailed  is  the  particular  form  of  the 
equations  most  suited  to  performance  studies  of  these  two 
aircraft. 
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ABSTRACT 


The  equations  that  describe  both  the  navigation 
mechanization  and  the  propagation  of  errors  in  an  unaided 
inertial  system  are  detailed.  Extensions  of  these  equations 
which  apply  to  continuous  speed  and  altitude  damping  are 
also  given.  A general  vector-matrix  notation  is  employed, 
thereby  eliminating  the  need  to  specify  a particular  naviga- 
tor mechanization  before  setting  dovm  the  error  equations. 

Specific  application  of  the  general  equations  to  the 
local-level,  wander -azimuth  mechanization  is  outlined.  The 
detailed  form  of  the  error  equations  is  given  for  both  the 
free-inertial  case  and  various  choices  of  continuous  damping. 


1 


1 

i 


I i 


I 1 


t 


iii 


THE  ANALYTIC  SCIENCES  CORPORATION 


TABLE  OF  CONTENTS 


Page 

No. 


Forev'ora  ii 

Abstract  iii 

Table  of  Contents  iv 

List  of  Figures  vi 

List  of  Tables  vi 

1.  INTRODUCTION  1-1 

2.  VECTOR  FORMULATION  OF  MECHANIZATION  AND  ERROR 

EQUATIONS  FOR  AN  UNDAMPED  INERTIAL  SYSTEM  2-1 

2.1  Unified  Equation  Subset  2-1 

2.2  Notation  and  Definitions  for  the  MechaJiization  Equations  2-2 

2.3  Mechanization  Equations  2-2 

2.4  Notation  and  Definitions  for  the  Error  Equations  2-4 

2.5  Error  Equations  2-4 

2.6  Platform  Misalignment  Equations  2-7 

3.  SPECIALIZATION  OF  THE  ERROR  EQUATIONS  TO  A WANDER- 
AZIMUTH  LOCAL-LEVEL  INERTIAL  SYSTEM 

MECHANIZATION  3-1 

3.1  Description  of  Wander-Azimuth,  Local-Level  Mechanization  3-1 

3.2  Components  of  Angular  Rate  Vectors  ’n  N,  E,  Z 

Coordinates  3-3 

3.3  Error  Equations  in  Component  Form  3-4 

3.4  Recovery  of  Azimuth  Pointing  Error  3-6 

4.  INERTIAL  SYSTEM  MECHANIZATION  AND  ERROR  EQUATIONS 
WITH  STABILIZED  ALTITUDE  CHANNEL,  ALTITUDE 

DAMPING  AND  VELOCITY  DAMPING  4-1 

*4.1  Rationale  for  Damping  4-1 

4.2  Notation  and  Definitions  for  Mechanization  and  Error 

Equations  4-1 

4.3  General  Mechanization  4-2 

4.4  Generalized  Error  Equations  4-4 


IV 


THE  ANALYTIC  SCIENCES  CORPORATION 


4.5 

4.6 

APPENMX  A: 
APPENDIX  B: 
REFERENCES 


TABLE  OF  CONTENTS  (Concluded) 


Altitude  Stabilized  and  Velocity  Damped  INS  Error 
Equations  for  a Local  Level  Mechanization 
E^ension  of  the  Local-Level  Error  Equations 
to  the  Altitude  Eiamped  Case 

A DERIVATION  OF  THE  NAVIGATION  ERROR 
EQUATIONS 

NAVIGATION  ERROR  EQUATIONS  EXPRESSED  IN 
TERMS  OF  PLATFORM  MISALIGNMENT  ANGLES 


Page 

No. 

4-7 

4-10 

A-1 

B-1 

R-1 


V 


THE  ANALYTIC  SCIENCES  CORPORATION 


LIST  OF  FIGURES 

Figure  Page 

No.  No. 

1- 1  Multi-Sensor  Aided  Inertial  Navigation  System  Operation  1-2 

2- 1  Inertial  Navigation  Error  Dynamics  2-6 

3- 1  Local-Level,  Wander-Azimuth  Geometry  3-2 

3- 2  Azimuth,  Heading  Error  Sign  Conventions  3-7 

4- 1  Damped  Altitude  Channel  Error  Equation  Diagram  4-11 

LIST  OF  TABLES 

Table  Page 

No.  No. 

2-1  General  Free  Inertial  Navigation  Error  Equations  2-8 

4-1  Velocity  and  Altitude -Aided  Inertial  Navigation  S>’stem  4. 6 

Error  Equations 

4-2  Complete  Error  Equations  for  Velocity  and  Altitude  4-14 

Aided  Local-Level,  Wander-A'-'imuth  INS 


THE  ANALYTIC  SCIENCES  CCnPORATION 


1. 


INTRODUCTION 


The  errors  of  an  unaided  inertial  navigation  system  (INS)  typically 
grow  with  time  in  an  unboundec  manner.  As  a consequence,  the  cruise  inertial 
navigation  systems  used  in  mcdern  aircraft  and  submarines  are  normally  aided 
or  ’’damped"  with  data  from  external  aids,  such  as: 

• altimeter  or  depth  gauge 

• speed  reference  (doppler  radar  or  EM-log) 

• position  reference  (LORAN,  NAVSAT,  ...) 

The  errors  of  an  aided  INS  are  typically  bomided,  although  the  errors  grow  in- 
between  position  fixes. 

The  techniques  that  are  used  to  combine  external  reference  data  with 
INS  outputs  fall  into  two  categories:  "con^•entional  continuous -feedback  damp- 
ing" and  "Kalman-filter  damping".  Conventional  continuous-feedback  techniques 
are  usually  used  with  altitude  and  speed  reference  devices,  whereas  Kalmaji- 
filter  techniques  are  frequently  used  with  position  reference  devices.  However, 
the  trend  in  recent  years  has  been  toward  more  extensive  use  of  Kalman- 
filter  techniques.  An  overall  conceptual  diagram  of  a multi-sensor  aided  INS 
is  shown  in  Fig.  1 -1 . 

The  purpose  of  this  report  is  to  present  the  mechaniyation  and  linear- 
ized  error  propagation  equations  for  rho  following  cases; 

• Unaided  INS 

• Speed-damped  INS 

First-order  damping 
Second-order  damping 
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• Altitude-damped  INS  j 

First-order  damping 
Second-order  damping 

’ i 

> In  this  report,  it  is  assumed  that  speed  and  altitude  damping  are  accomplished  I 

with  conventional  continuous-feedback  loops.  A forthcoming  report  will  treat  ! 

[ the  case  of  Kalman-filtcr  damping  vdtli  speed, altitude,  and  position  references.  j 

The  mechanization  and  error  propagation  equations  given  in  this  report  i 

are  applicable  to  the  inertial  navigation  system  in  any  Icrreslrial  vehicle-  -for  j 

example,  a jeep,  aircraft,  submarine,  or  missile.  However,  it  should  l)c  kept  ■ 

I in  mind  Lliat  missile  inertial  navigation  systems  are  typically  not  damped  witli  I 

( I 

[ external  aids.  In  such  a case,  only  the  frec-incriial  equations  arc  applicable.  | 

! ‘ i 
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Error  Sources  - The  error  sources  which  are  considered  in  this 
equation  subset  are  those  inherent  to  the  INS  itself,  to  velocity  damping  and  to 
altitude  stabilization.  Detailed  error  models  and  treatment  of  errors  in  ex- 
ternally derived  measurements  will  be  deferred  until  the  third  equation  subset. 
The  error  quantities  of  interest  in  this  subset  are: 


accelerometer  errors 
altitude  reference  errors 
gyro  drift  rates 
position  and  velocity  errors 


platform  misalignments 
velocity  reference  errors 
vertical  deflections 
gravity  anomalies 


Coordinate  Frames  - Several  coordinate  systems  whose  origins  are 
common  with  the  center  of  the  earth  are  used  in  the  equations.  They  are: 


• An  inertial  frame  whicli  has  its  axes  fixed  with  respect 
to  the  "fixed"  stars, 

• A local  level  frame  which  has  two  axes  tangent  to  and  a 
third  axis  normal  to  a reference  ellipsoid  at  the  locality 
under  consideration, 

• A true  frame  corresponding  to  the  ideal  (i.e.,  error  free) 
orientation  of  the  inertial  platform  (mechanization  dependent) 
at  the  vehicle's  actual  position, 

• An  earth  fixed  frame  with  axes  embedded  in  and  non- 
rotating with  respect  to  the  earth, 

• The  platform  frame  with  axes  parallel  to  the  nominal  accel- 
erometer  input  axes, 

• Tlic  frame  m which  tliC  navigation  equation  mechaniza- 
tion actually  occurs.  Because  of  errors,  this  frame 
will  not  be  the  same  as  tiiat  in  wliich  the  equations  are 
nominallv  mochanizeci  (irue  frrimei.  This  reference 
frame,  whicli  is  specified  by  '.ic  navigation  system  out- 
puts of  ])osition  and  velocitv  is  the  so-called  computer 
frame. 
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Usually,  the  true  frame,  platform  frame,  and  computer  frame  are  coincident; 
Inertial  navigation  errors  lead  to  small-angle  misalignments  among  these 
frames. 


In  this  report  the  INS  mechanization  and  error  equations  are  derived 
and  presented  for  a variety  of  applications.  No  attempt  is  made  to  actually 
solve  the  equations,  although  in  the  course  of  deriving  them  qualitative  observa- 
tions about  the  form  of  the  solutions  are  given.  Where  background  material  is 
of  a lengthly  nature,  particularly  with  regard  to  equation  derivations,  appro- 
priate references  are  cited. 
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2.  VECTOR  FORMULATION  OF  MECHANIZATION  AND 

ERROR  EQUATIONS  FOR  AN  UNDAMPED 
INERTIAL  SYSTEM 


2. 1 UNIFIED  EQUATION  SUBSET 

A vector  formulation  of  the  navigation  mechanization  and  error  equa- 
tions is  presented  in  this  Chapter.  This  formulation  is  completely  general- - 
that  is,  valid  for  any  dynamically-exact*  INS  mechanization  (local  level,  space 
stable,  tangent  plane,  strapdown,  etc.).  Such  a unified  approach  allows  one 
equation  "module"  to  serve  all  cases  and  provides  notational  consistency.  It 
is  not  surprising  that  a single  set  of  equations  can  properly  describe  all  inertial 
systems.  Any  such  system  is  a mechanization  of  Newton’s  second  law  which 
itself  is  invariant.  The  inertial  equations  are  but  a more  detailed  formulation 
of  the  force-momentum  relationship  specialized  to  the  navigation  process. 
Expansion  of  the  general  vector  equations  in  a form  specific  to  a local-level 
INS  mechanization  is  demonstrated  in  Chapter  3. 

Although  the  error  propagation  is  frame-independent,  the  instrument 
error  models  are  not,  hence  the  sensor  error  equations  must  be  tailored  to 
each  mechanization.  For  example,  a drifting  gyro  in  a locally-level  mechanized 
INS  does  not  induce  the  same  dynamical  position,  velocity  and  tilt  errors  as  the 
same  drifiting  gyro  ^vould  cause  in  a space-stable  INS  (Ref.  1).  In  tliis  document 
consideration  of  error  sources  (such  as  gyro  drift  rate)  will  be  limited  to  their 
treatment  as  driving  terms  in  the  equations.  Detailed  models  of  error  sources 
v/ill  bo  presented  in  tlie  third  ec|uation  subset. 

*"Dynamically  exact"  implies  that  if  there  were  no  instrument  measuring  errors 
or  initial  alignment  errors,  the  INS  outputs  would  be  error -free.  This  is  some- 
times referred  to  as  "no  errors  due  to  true  veliicle  motion.” 
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2.  2 NOTATION  AND  DEFINITIONS  FOR  THE  MECHANIZATION  EQUATIONS 

^ (. . . )g  = Time  rate  of  change  of  (...)  as  seen  by  an  observer 
in  a general  S frame 

R = Vehicle  position  vector 

V = (R)_  =•  Vehicle  Velocity  in  an  earth  fixed  frame  - "ground 

^ speed" 

A = Specific  force,  i.  e. , vehicle  acceleration  due  to  all  forces 
acting  except  gravity  (ideal  accelerometer  output) 

g(R)  = Plumb  bob  gravity  acceleration  on  vehicle 

7i  = Angular  rate  of  earth  fixed  axes  \vith  respect  to 
inertial  space 

oo„g  = Angular  rate  of  a general  S frame  with  respect  to 
another  general  R frame 

cojp  = Angular  rate  of  computer  frame  with  respect  to  inertial 
space 

copp  = Angular  rate  of  computer  frame  with  respect  to  an  earth 
fixed  frame 

A-B  = Scalar  product  of  vectors  A and  B 
A ^ B = Vector  cross  product  of  vectors  A and  B 


2.3  MECHANIZATION  EQUATIONS 


The  mechanization  equations  for  an  unaided  INS  are  (Ref.  2): 


^ (V)^  - A ^ g (R)  - (cu'j(^  I n)  y.  V 


(2-1) 


dF  ^ - -EC  ^ ^ 


(2-2) 


2-2 


THE  ANALYTIC  SCIENCES  CORPORATION 


Note  that  the  vector  quantities  (ovorbar  notation)  in  these  equations  require  no 
subscripts  to  designate  a coordinate  system  since  the  magnitudes  and  direc- 
tions they  specify  are  independent  of  the  reference  frame  in  which  they  are 
ejqjressed.  The  vectors  V,  S,  and  g in  Eqs.  (2-1)  and  (2-2)  are  the  "truo" 
position,  velocity,  specific  force,  and  gravity  acceleration.  However,  since 
the  navigation  computer  deals  only  with  "computed”  quantities  gj^), 

the  equations  actually  -mechanized  are: 

W <^c'c  = ^ (“IC" 

■Hf  ^*^0  “ ■ “’ec 

where 

= accelerometer  outputs 

= INS  outputs  of  vehicle  groundspeed  (a  3-vector) 

^ = INS  outputs  of  vehicle  position  (a  3 -vector) 

The  term  g^(R^)  in  Eq,  (2-3)  must  include  earth  oblateness  terms  in  order  to 
provide  an  accurate  g -avity  computation  (Ref.  10).  Neglecting  the  earth's 
ellipticity  can  cause  position  errors  on  the  order  of  ten  nautical  miles  (Ref.  3). 
Although  the  non-spherical  character  of  the  earth  is  explicitly  expressed  in  the 
mechanization  equations,  usual  practice  is  to  neglect  it  in  the  error  equations. 
Further  discussion  of  Eqs.  (2-3)  and  (2-4)  is  given  in  Appendix  A. 


2-3 


THE  ANALYTIC  BCIENCES  CORPORATION 


u 


2. 4 NOTATION  AND  DEFINITIONS  FOR  THE  ERROR  EQUATIONS 


c> 

1 

II 

> 

•o 

(2-5a) 

1 

J 

sR  = 

(2-5b) 

6g  = i(I^)  - g(R) 

(2-5c) 

= small  angle  misalignment  between  platform  and 
computer  frames  (defined  positive  for  rotation  from 

-- 

computer  frame  to  platform  frame) 

^ = total  accelerometer  error  (difference  between  ideal 

and  actual  accelerometer  output) 

■Jg  = gravity  anomaly  and  vertical  deflections  (gravity 
disturbance  vector) 

g = nominal  value  of  gravity  (scalar) 

7 = total  gyro  drift  rate  error  due  to  all  gyro  error  sources 

Rq  = nominal  radius  of  the  earth  (scalar  magnitude) 

R - magnitude  of  R 


2 . 5 ERROR  EQUATIONS 

The  free  (unaided)  inertial  system  error  equations  are  derived  in 
Appendix  A.  They  are: 

(6 V)g  ~ M ~ ^ A + 6g  - (tOjg  + fll  ^ 6V  (2-6) 


±(6R)g  = 6V-i;.jgX6R 


(2-7) 

(2-8) 


■n 


I 

li 

i. 


It 


i 


H 
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>51 


Note  that  Eq.  (2-9)  contains  no  eiqillcit  treatment  of  earth  ellipticity  errors. 

Such  errors  are  of  second  order  size  and,  as  such,  may  be  neglected. 

For  a slowly-moving  vehicle,  eqviations  (2-6)  to  (2-9)  contain  undamped 
oscillatory  dynamics  at  both  the  Schuler  (84  minute  period)  and  earth  (24  hour 
period)  rates.  This  dynamical  behavior  is  encountered  in  all  terrestrial  iner- 
tial navigation  systems,  regardless  of  the  nominal  platform  orientation  (local 
level,  space  stable,  strapdown,  etc.)  and  may  be  seen  by  writing  out  Eqs.  (2-6) 
to  (2-8)  in  a particular  reference  frame  and  taking  eigenvalues.  That  such  is 
the  case  is  not  surprising  when  it  is  recalled  that  Eqs.  (2-6)  through  (2-9)  express 
vector  quantities  in  a generalized  coordinate  frame.  The  dynamics  they  describe 
must  be  invariant  with  regard  to  the  reference  system  in  which  they  are  cast. 
Later  in  this  report  these  equations  ^vill  be  written  out  term  by  term. 

Note  that  the  solution  of  Eq.  (2-8)  for  the  computer  to  platform  mis- 
alignments is  Independent  of  the  position  and  velocity  error  equations  (Eqs. 

(2-6),  (2-7)).  The  navigation  error  equations  may  thus  be  considered  as  being 
driven  by  the  ^ errors.  This  partial  decoupling  of  the  equations  is  depicted 
in  Fig.  2-1  and  the  attendant  simplified  form  of  the  error  equations  is  a major 
rationale  for  expressing  them  in  terms  of  the  0 angles. 

It  is  appropriate  to  point  out  the  difference  in  the  character  of  Eqs. 

(2-6)  through  (2-8)  depending  upon  whether  the  vehicle  travels  at  "high"  or 
"low"  speeds.  In  general,  for  no  limitations  on  rates  of  motion  the  error 


2-5 


TtWE  ANALYTIC  SCIENCES  CORPORATION 


INHIAl 

CCXOTIONS 


GYRO  DRIFT 
RATE  ERRORS 


INITIAL 

OONOmONS 


ACCELEROMETER 

ERRORS 


GRAVITY 

DISTURBANCES 


1 L 


EARTH 

"IT' ANGLES 

SCHULER 

(SiMIN) 

LOOP 

posmoN 

ERROR 

VEUDCTTY 

ERROR 


Figure  2-1  Inertial  Navigation  Error  E)ynamics 


equations  possess  time -varying,  trajectory -dependent  coefficients.  However, 
if  the  maximum  vehicle  accelerations  and  velocities  are  sufficiently  small  so 
that: 

1.  A <<  g In  Eq.  (2-6) 

2.  ai,  « 7i  inEqs.  (2-6),  (2-8)(earth  rate  » vehicle  rate) 

3.  logg  6l^<<5V  in  Eq,  (2-7) 

the  error  equations  reduce  to  the  essentially  constant  coefficient  relations: 


g + Fi-2nx6V 

(2-10) 

^ s " 

Iv 

(2-11) 

- n V i/,  + f 

(2-12) 

The  "small"  velocity  and  acceleration  assumptions  required  for  the  validity  of 
Eqs.  (2-10)  through  (2-12)  are  generally  met  for  marine  vehicles. 
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2. 6 PLATFORM  MISALIGNMENT  EQUATIONS 

The  angular  misalignment  between  the  true  (S)  frame  and  the  com- 
puter (C)  frame  is  defined  as  the  small  angle  ^ where  positive  ^ is  taken  from 
the  true  frame  to  the  computer  frame.  This  angle  is  a function  of  position 
error  only. 

B = e(6R)  (2-13) 

The  small  angular  misalignment,  0,  between  the  platform  frame  and 
the  true  frame  (platform  "tilt")  is  given  by: 

0 = ■?  + 5^  (2-14) 

where  positive  0 corresponds  to  rotation  from  the  true  frame  to  the  platform 
frame.  Note  that  the  solution  of  Eq.  (2-14)  for  the  vector  angle  0 provides  the 
azimuth  error  although  the  required  combination  of  0 components  needed  is 
reference  frame  dependent. 

It  is  not  necessary  to  solve  Eqs.  (2-6)  through  (2-9)  prior  to  finding 
0 in  Eq.  (2-14).  Instead,  the  expressions  (2-13),  (2-1 4)  can  be  substituted 
into  Eqs.  (2-6)  to  (2-8)  and  the  error  equation  set  expressed  in  terms  of  the 
platform  misalignment  angles,  0,  instead  of  the  computer  misalignment,  W. 
However  this  has  not  been  done  here  for  several  reasons: 


1.  The  decoupling  associated  with  the  0 angle  representation 
(see  discussion  in  previous  Section)  does  not  occur  when 

0 is  the  misalignment  variable  in  the  equations. 

2.  The  additional  relations  between  6 and  6R  (Eq.  (2-13))  must  be 
included  necessitating  the  specification  of  a reference  frame  in 
which  the  error  equations  are  to  be  written.  A resultant  loss 
of  generality  occurs. 

3.  The  form  is  directly  suitable  for  use  with  externally  sup- 
plied stellar  observation  information.  (CT  is  the  angle  which 
is  measured  by  a star  sensor. ) 
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In  the  interest  of  completeness  the  <t>  formulation  of  the  error  equations  is  given 
in  Appendix  B . 

Equations  (2-6)  through  (2-9),  Eqs.  (2-13)  and  (2-14)  comprise  the 
complete  description  of  unaided  inertial  system  error  propagation.  This 
equation  subset,  summarized  in  Table  2-1,  properly  describes  the  error 
behavior  for  any  navigation  mechanization.  An  example  of  one  such  mechani- 
zation is  given  in  the  next  Chapter. 


TABLE  2-1 

GENERAL  FREE -INERTIAL  NAVIGATION  ERROR  EQUATIONS 


d 

W 

(6V)s  = 

^ - lixA  + flg- 

(a'jg  + a)  X fiV 

d 

3t 

(^)g  = 

6V  - a:^g  X 6R 

d 

dt 

(^)s 

“it'jg  + ( 

= Ag  - 

gRo  - 3gR2 

(^  • R)  R 

e 

= e(^) 

(reference  frame  dependent) 

0 

= 6 + ip 

the  analytic:  SlIgic-ncl's  c.-nr^r^onATic  ■ o 


3 . SPECIALIZATION  OF  THE  ERROR  EQUATIONS  TO  A WANDER- 
AZIMUCFtT  LOCAL-LEVEL  INERTIAL  SYSTEM  MECHANIZATION 

Some  inertial  systems  are  designed  to  mechanize  the 
navigation  equations  in  a local-level,  wander-azimuth 
configuration.  Accordingly,  in  order  to  be  directly 
applicable  to  analysis  involving  such  systems,  the 
generalized  error  propagation  equations  listed  in  the 
previous  Chapter  will  now  be  detailed  in  this  mechaniza- 
tion . 

3.1  DESCRIPTION  OF  WANDER-AZIMUTH,  LOCAL-LEVEL  MECHANIZATION 

A wander-azimuth,  local  level  mechanization  involves 
aligning  the  INS  platform  to  be  perpendicular  to  the 
local  geodetic  vertical.  The  gyro  which  censes  rotation 
about  the  vertical  is  untorqued*  and,  as  a result,  the 
platform  will  not  maintain  a particular  terrestrial  head- 
ing reference.  Instead,  orientation  with  respect  to 
north  will  vary  with  time  and  vehicle  position  by  the 
so-called  "wander  angle."  The  geometry  is  depicted  in 
Fig.  3-1. 


* The  vertical  gyro  is  untorqued  only  insofar  as  navi- 
gation variables  are  concerned.  Torques  applied  to 
cancel  bias  error  or  to  align  the  platform,  are  left 
unaffected  by  this  disucssion. 
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Figure  3-1  Local-Level,  Wander-Azimuth  Geometry 


Notation  and  Definitions 
= unit  vector  pointing  in  the  north  direction 

Fj,  = unit  vector  pointing  in  the  east  direction 

= unit  vector  pointing  dov-n  along  the  position  radius 
vector 

a = counterclockwise  rotation  of  the  platform  X axis 
■ from  north  alignment  (viewed  from  above);  wander 
angle 


A A - 


h 

L = 


north,  east  and  down  components  of  specific  force 

X and  Y components  of  specific  force  (X,  Y are 
platform  coordinates) 

altitude  above  the  reference  ellipsoid 

latitude 


I 


I 1 


< 

:1 


i 

I 
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X = 
V = 

e = 

Ag  = 

Vn  ■ 
Ve  = 

V„  = 


•N’  ‘E’  'z 


east  longitude 

east  vertical  deflection  \ 

/ A more  detailed  description 

north  vertical  deflection  v qJ  gravity  disturbances  is 

( given  in  Ref.  5. 
gravity  anomaly  1 

north  component  of  groundspecd 

east  component  of  groundspeed 

rate  of  change  of  altitude  above  the  reference  ellipsoid 

north,  east  and  vertical  gyro  drift  rate  components 
of  7 


6 = error  in  quantity  which  follows;  e.  g. 

6V.,  = V..  (measured)  - (correct  value) 
N N N 


R = RT^  = -(R^  + h)l*2 


(3-1) 


5 R = - fihfr. 


(3-2) 


6hT. 


(3-3) 


3.  2 COMPONENTS  OF  ANGULAR  RATE  VECTORS  IN  N,  E,  Z COORDINATES 


In  north,  east,  down  (N,  E,  Z)  coordinates,  the  earth's  angular  rate 


7i  is; 


D = cos  L ij^  - n sin  L i ^ 


(3-4) 


The  angular  rate  of  the  platform  with  respect  to  tlie  eartli  (platform  rate)  is: 


V ^ V /.V 

‘^'es  " IT  ^N  " IT  'e  ■ ~R 


(3-5) 
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The  platform  rate  plus  the  earth's  rate  is: 


a: 


IS 


ncosL*  ^)r^. 


Of  + Q L + tsji  l) 


(3-6) 


Because  the  Z gyro  is  untorqued,  the  i^  component  of  ijg  is  zero. 


Consequently  Eq.  (3-6)  becomes: 


TS 


ficos  L + 


(3-7) 


and  the  rate  a is  given  by: 


- n sin  L - tan  L 


(3-8) 


Equation  (3-8)  is  the  mechanization  equation  for  the  wander  angle,  a • Note  that 
or  is  not  an  error  quantity  and  must  be  calculated  from  the  assumed  trajectory 
via  this  relation  prior  to  the  solution  of  the  error  equations. 


3.3  ERROR  EQUATIONS  IN  COMPONENT  FORM 

There  are  two  useful  choices  of  coordinates  in  which  to  solve  the 
error  equations,  namely  the  north,  east,  down(N,  E,  Z)  or  platform  (X,  Y,  Z) 
frames. 

1.  For  the  N,  E,  Z frame  solution  it  is  necessary  to  project  the  sensor 
errors,  u and  7 wliich  are  given  in  X,  Y coordinates  into  components 
along  tlie  N,  E axes.  Tlie  solutions  to  the  equations  arc  (he  North,  East 
and  Down  referenced  velocity,  position  and  alignment  errors.  Tliese 
are  the  errors  of  interest  in  analysis. 
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2.  A solution  of  the  error  equations  in  X,  Y,  Z coordinates  allows  the  use 
of  the  gyro  and  accelerometer  errors  without  transformation  but  does 
require  tiansformation  of  the  gravity  errors  which  are  conventionally 
specified  in  terms  of  N,  E,  Z coordinates.  In  addition,  the  solutions  to 
the  equations  (velocity,  position  and  alignment)  are  usually  required  In 
N,  E,  Z coordinates. 

Each  of  the  representations  above  requires  a transformation  to  be  applied 
to  driving  errors  (gyro,  accelerometer  vs.  gravity),  but  since  the  N,  E,  Z 
choice  requires  no  output  transformation,  this  frame  was  selected  for  solution 
of  the  equations.  Note  that  this  choice  effects  computational  savings  as  the 
necessary  transformations  apply  only  to  two  components  (X,  Y)  of  each  of  two 
three-vectors  (/T,  7).  Choice  two  above  would  have  required  transformation  of 
two  components  (N,  E)  of  one  three-vector  (^)  and  six  components  of  one  nine- 
vector  (fiV,  '^),  a somewhat  greater  computational  load. 

In  expanded  (component)  form,  the  velocity  error  Eqs.  (2-6) 

become; 

5Vn  = cos  a + My  sin  a - 

- I * gi  -(2  n sin  L + ^ tan  l)  6Vj,  + ^ (3-9) 


= n Y cos  a - n,;  sin  o * ' B 


gT7+l2r?sinL  + -cjy-  Ian  L ) 6V-,  + (20  cos  L 


(3-10) 
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V / V \ 

- 6h  + Ag  - ^ ^ tF)  ^^E 


(3-11) 


The  position  error  equations  are: 


tan  L «Rg  - 


(3-12) 


V V 

tan  L 6R^  . ^ 6h 


(3-13) 


6h  - -6V2+  R 


(3-14) 


The  computer-to-platform  misalignment  equations  are: 


'^N,  ( 

- T^z'V 


f>  sin  L + tan  cosa  + fy  sin  a 

(3-15) 


(3-16) 


n cos  L + ^ j 02 


{ \ 

lO  sin  L + ^ tan  L)0j^  - 


sin  a + €y  a 


. ' Vn  / - Vg\ 

0Z  = - -fp  ^ ^ 


(3-17) 


3.4  RECOVERY  OF  AZIMUTH  POINTING  ERROR 


Azimuth  error  is  contained  implicitly  in  Eq.  (2-14).  The  angle  ^ 
results  from  errors  in  computed  position  with  components  given  by: 
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®N  ■ R 


(3-18) 


~TT 


(3-19) 


tan  L 


(3-20) 


The  components  of  the  platform  misalignment  angle,  0,  are: 


fiRj, 

^ ~~W 


" R 


(3-21) 


(3-22) 


^z- 


(3-23) 


The  last  equation  specifies  azimuth  pointing  error  0^.  Note  that  this  angle  is 
defined  in  the  opposite  sense  of  the  quantity  commonly  referred  to  as  "heading 
error."  These  relations  are  depicted  in  Fig.  3-2. 


TAUI  HEADING 


INDICATED  HEADING 


- heading  error 


A2IMUTM  ERROR 


Figure  3-2  Azimuth  and  Heading  Error  Sigii  Conventions 
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Equations  (3-9)  through  (3-20)  and  Eq.  (3-23)  comprise  the  subset 
which  describes  error  propagation  in  an  unaided  local-level,  free-azimuth 
inertial  navigator.  Equations  (3-21,  22)  are  auxilliary  relations  which  may  be 
used  to  find  platform  tilt  errors. 
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4.  INERTIAL  SYSTEM  MECHANIZATION  AND  ERROR  EQUATIONS 
WITH  STABIUZED  ALTITUDE  CHANNEL,  ALTITUDE 
DAMPING  AND  VELOCITY  DAMPING 


4. 1 RATIONALE  FOR  DAMPING 

It  is  well  known  that  the  altitude  channel  of  an  unaided  inertial  system 
is  unstable  (Ref.  2).  This  characteristic  is  commonly  corrected  by  employing 
an  externally  measured  altitude  reference  (e.g. , barometric  or  radar  altimeter) 
to  stabilize  the  INS  vertical  axis.  A detailed  discussion  of  altitude  damping  is 
given  in  Ref.  6. 

The  horizontal  channels  of  an  unaided  INS,  while  not  unstable,  are 
undamped  and  hence  only  marginally  stable.  A small  amount  of  spectral  energy 
from  error  sources  which  drive  the  Schuler-loop  (accelerometer  noise,  vertical 
deflections,  earth  loop  errors  (C^)  etc.)  is  sufficient  to  caxise  unbounded  growth 
of  the  navigation  errors.  These  errors  are  "damped"  by  making  use  of  exter- 
nal velocity  measurements  such  as  are  furnished  by  doppler  radar. 

In  the  discussion  above,  a distinction  between  "vertical"  and  "horizon- 
tal' channels  has  been  made  largely  to  take  advantage  of  intuitive  notions  which 
are  typically  directed  toward  local-level  mechanization  schemes.  In  general, 
as  is  illustrated  in  the  equations  below,  externally  supplied  altitude  and  velocity 
information  may  be  used  to  stabilize  and  damp  an  INS  regardless  of  its  mechani- 
zation (local  level,  space  stable,  strapdowm,  etc.). 

4.  2 NOTATION  AND  DEFINITIONS  hDR  MECHANIZATION  AND  ERROR 
EQUATIONS 

h^  = Vehicle  altitude  supplied  by  external  altitude  reference 
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V = Vehicle  groundspeed  supplied  by  external  velocity 
reference 

Vj  = Velocity  damping  state  variables  (a  3-vector) 

= First  order  damping  constant  matrix 

Kg  = Second  order  damping  constant  matrix 

T = Gyro  torqulng  feedback  gain  matrix  (earth  rate 
gyrocompasslng  constant) 


Plumb  bob  gravity  acceleration  calculated  from 
both  externally  and  inertlally  indicated  altitude 


K = Weighting  constant  (scalar)  governing  the  pro- 
portion of  externally  and  Inertially  measured 
altitude  used  to  calculate  gravity 

6V  = External  velocity  reference  error 
r 

6V^  = Velocity  clamping  state  error 


4.3  GENERAL  MECHANIZATION 

4.3.1  Schuler  Loop  Damping  Mechanization 

The  specific  force  equation  (2-3),  modified  to  include  continuous 
second-order  external- velocity  damping  and  altitude  stabilization  is  given  below 


at  'Vc’c  = "r>  - <-IC  * ■'<  ''c  ■ <''c  ‘ ''r'  " >^2  (4-1) 

with  the  auxiliary  relation: 


A (V  ) 
dt  "^d'c 


■"l  <'c  - ''r>  - ^2  Vd 


(4-2) 


Note  that  for  an  error-free  system, the  reference  velocity,  V^,is 
equal  to  the  computed  velocity,  Vq.  and  the  initial  condition  of  the  second  order 
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damping  variable,  V^,  is  zero.  Also,  in  such  an  ideal  system  and 
provide  the  same  value  of  gravity.  Under  these  conditions  Eq.  (4-1)  reduces 
to  Eq.  (2-3)  hence  demonstrating  the  dynamic  exactness  of  the  aided  system. 
Equations  (4-1)  and  (4-2)  describe  a second-order  velocity- damped  INS  mechan- 
ization. This  consists  of  proportional  and  integral  feedback  of  the  difference 
between  externally  and  inertiallly  measured  velocity  to  the  acceleration  sum- 
ming node.  First  order  velocity  damping  which  involves  only  proportional 
feedback  may  also  be  described  by  Eq.  (4-1)  by  the  setting  of  the  gain  constant, 
Kg,  to  zero.  The  damping  state  variable,  and  Eq.  (4-2)  become  redundant 
in  this  case. 


■s 

•s 


a 


I 

u 


:i 

u 


I 

( I 


1 

4.3.2  Earth  Loop  Damping  Mechanization 

While  a complete  discussion  of  the  various  platform  alignment  proce- 
dures is  beyond  the  scope  of  this  equation  subset,  error  equation  generality 
requires  consideration  of  platform  misalignment  angle  recovery  from  the  ex- 
ternally supplied  velocity  data.  For  this  purpose  it  is  assumed  that  the  gyros 
are  torqued  with  a signal  which  is  proportional  to  the  difference  between  Iner- 
tially-derived  and  externally-measured  veloci<:v,  i.e., 


Total  Command  Gyro  Rate  = Mechanization  Torqued  Rate  r (Vp  - V ) 

Note  that  the  first  term  on  the  right  hand  side  of  the  expression  above  is  the 
commanded  gyro  rate  corresponding  to  the  particular  mechanization  involved; 
hence  it  is  generally  different  for  each  mechanization.  The  underlined  term  is 
the  additional  gyro  rate  which  incorporates  the  velocity  feedback.  As  will  be 
seen  in  the  next  section,  this  term  mechanizes  the  earth  loop  damping. 

In  considering  this  procedure,  it  is  necessary  to  distinguish  between  the  INS 
"navigate  mode"  and  "alignment  mode."  The  latter  case  in  which  navigation 
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information  is  not  being  extracted  from  the  INS  but  in  fact  is  being  supplied  to 
it  for  purposes  of  system  alignment  is  not  considered  here.  Attention  is  con- 
fined the  navigate  mode  during  which  the  system  continuously  supplies  the 
user  with  current  values  of  his  velocity,  position  and  heading.  One  may  look 
at  this  velocity -to -gyro  feedback  in  two  ways,  either  as  an  alignment  proce- 
dure in  which  the  navigate  mode  is  maintained  or  as  simply  another  use  of 
external  velocity  data  to  improve  knowledge  of  an  INS  variable,  in  this  case  lU. 
Mechanization  considerations  pertinent  to  the  use  of  an  external  velocity  sig- 
nal to  drive  the  gyros  are: 

• The  external  velocity  reference  must  be  very  accurate  in 
order  to  prevent  significant  velocity  errors  from  being 
introduced  into  the  earth  rate  (0)  loop. 

• Even  a "good"  external  velocity  reference  will  contain 
enough  error  to  require  small  values  for  the  feedback 
gain  constants  ("light"  damping). 


4.  4 GENERALIZED  ERROR  EQUATIONS 

4.4.1  Damped  Schuler  Loop  Error  Propagation 

Perturbation  of  Eqs.  (4-1)  and  (4-2)  leads  to  the  following  error 
equations  (Ref,  7). 

^ (6V)g  = 6~A.  - if.  X A + 6g  (<5h,<5h^)-  (ojjg  t-  o)  >:  6V 

- Kj  (6V  +'^  X V - 6V^)  f- K2  6V^  (4-3) 

^(6Vd)g  - Kj  (6V  + V - 6V^)  - (4-4) 
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In  the  derivation  it  is  assumed  that  the  externally-measured  velocity  is 
available  in  platform -frame  coordinates.  (This  is  the  usual  case  for  aircraft 
doppler  or  shipboard  velocity  log  measurements. ) The  fact  that  the  platform 
and  computer  frames  are  misaligned  by  the  angle  gives  rise  to  the  if  x V 
terms  in  Eqs.  (4-3)  and  (4-4). 


4.4.2  Damped  Earth  Loop  Error  Propagation 

As  a result  of  the  applied  gyro  torques  which  are  proportional  to  the 
measured  velocity  error,  the  if  error  equation  (24  hour  dynamics)  is  damped. 
Equation  (2-8)  then  becomes: 

^(if)g  = - Wjg  X i5+ T (6V  + i X V - 6V^)  + F (4-5) 

The  r term  in  Eq.  (4-5)  results  in  extraction  of  alignment  information  (if)  from 
the  reference  velocity.  Because  this  is  the  same  process  as  is  used  in  g>'fo- 
compassing  (when  the  reference  velocity  is  accurately  known  to  be  zero)  it  is 
referred  to  (in  the  aircraft  case)  as  "doppler  inertial  gyro  compassing"  (Ref.  8). 
In  this  instance  the  velocity  reference  is  doppler  radar.  Additional  discussion 
of  doppler-inertial  gyrocompassing  while  in  the  navigate  mode  is  given  in  Ref.  9. 
Treatment  of  this  topic  as  part  of  the  alignment  proceedure  may  be  found  in 
Refs.  2 and  10  within  the  sections  describing  earth-rate  gyrocompassing. 


For  analysis  of  inertial  systems  which  do  not  employ  the  earth  loop 
damping  feature,  the  terms  involving  t in  Eq.  (4-5)  and  the  sequel  may  be 
omitted.  The  presence  of  e.xlernally  supplied  velocity  and  altitude  does  not 
affect  error  Eqs.  (2-7),  (2-9),  (2-13)  or  (2-14).  However  when  tliese  exter- 
nal measurements  are  used,  these  equations  m conjunction  with  Eqs.  (4-3) 
througli  (4-5)  above  describe  error  propagation  in  any  velocity-damped,  altitude- 
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Stabilized  Inertial  system  regardless  of  mechanization.  Note  that  this  set  of 
equations  which  are  summarized  in  Table  4-1,  reduce  to  the  unaided  navigation 
error  equations  given  in  Table  2-1  when  Kj,  K^,  and  r are  set  to  zero. 


TABLE  4-1 

VELOCITY  AND  ALTITUDE-AIDED  INERTIAL  NAVIGATION 
SYSTEM  ERROR  EQUATIONS 


3t  ~ - 0 X A + 6g  ffih,  “ ^IS  ^ ^ 


- Kj  (6V  + t!,  X V - 6V^)  4- 


Kj(5V.ij:xV-6Vp-K2  6V^ 


^ (fl^g  - fiV  - a-'gg  X 


= - o.'jg  X ^!)  + T (6V  + 0 X V - 6V^)  + 


~B  = ^ (3r)  (reference  frame  dependent) 


i = '5  + (j 
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4.5  ALTITUDE  STABILIZED  AND  VELOCITY  DAMPED  INS  ERROR 
EQUATIONS  FOR  A LOCAL  LEVEL  MECHANIZATION 

In  a local-level  system  the  gravity  errors  given  by  Ref.  11  can  be 
written  as: 


M ■■ 

6g  = g^Fj^  + griTg  + 1^:11  g6h-  ^ 6h^f  Ag 


(4-6) 


where  is  the  earth's  radius.  The  constant,  k as  defined  in  Eq.  (4-6) 
determines  the  relative  weighting  of  the  inertially -calculated  altitude  and 
that  measured  by  the  altimeter,  with  the  altimeter  being  weighted  more 
heavily  for  larger  k , Note  that  k may  be  any  positive  number  but  must  be 
greater  than  2 if  the  vertical  channel  is  to  be  stable. 

The  complete  set  of  error  equations  which  correspond  to  a velocity- 
and  altitude-aided  local-level,  wander-azimuth  mechanized  INS  Is  given  below. 
These  equations  have  been  derived  directly  from  the  general  error  equation 
set  given  in  Table  4-1.  Notation  which  has  not  previously  been  defined  is: 

^^rN  rE  rZ  ~ east  and  down  components  of 

^^dN  dE  dZ  ~ north,  east  and  down  components  of 

It  is  common  practice  in  velocity-damped  systems  to  set  all  of  the  off-diagonal 
elements  of  and  K2  to  zero.  This  simplifies  the  form  of  the  equations  and 
still  provides  all  of  the  feedback  which  will  significantly  improve  the  navigation 
errors.  The  remaining  elements  of  Kj,  and  the  nonzero  elements  of  r are 
defined  as  follows; 
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j 

Dtag.  [Kj]  = 

(kj  kj  0) 

(4-7) 

cj 

Diag.  [Kg]  = 

. 1 ^ 

(■'2  ''2 

(4-8) 

T = 

ro  r-  0 1 

(4-9) 

1 ' 

.0  Ty  0. 

Note  from  Eqs.  (4-7)  and  (4-8)  that  the  altitude  channel  is  not  velocity  damped. 
While  such  damping  could  be  implemented,  it  is  usual  instead  to  damp  the 
vertical  channel  with  the  external  altitude  signal.  This  is  discussed  in  greater 
detail  in  the  next  section. 


The  aided  inertial  navigation  eqxiations  for  a local-level,  free-azimuth 
mechanized  system  which  incorporates  the  gains  specified  by  Eqs..  '. -7)  through 
(4-9)  are  given  below: 


flV 


N ~ ^ ^ " R ^ 


20sin  L + tan  L 
rt 


6Vz  - 


(4-10) 


<^Ve  = cos  Q - sin  0(  + ' R "^^E  ^ 


+ (2nsinL tan  l)6Vj^+  (2rjcosL  + Z ' 


(4-11) 


I ’ 


L! 
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J 


-J 


8V 


‘'z  " *'z  * *E  • -^E*N  ■ M ^ 


■ IT  -(2OCOS  L + fiVg,  - kjVj^0g  + 

(4-12) 

^ ■*^2^^dN  ^1  ■ ^Z'^E  ~ ® ^rN^ 

(4-13) 

«VdE 

^ ■ ^2  *^dE  ^1  ^^^E  ^Z'^N  “ ^n'^z  “ ^^rE^ 

(4-14) 

V V 

= «V^--|tanL6Rj,-^  ah 

(4-15) 

8Rg 

= aVj,  .^tanL6R^-^  ai, 

(4-lG) 

8h 

‘ "T  "T  ^''e 

(4-17) 

= -^'‘Z-  ("®‘"L*Tr'^"O^E*^L‘''E*"L''N'^Z-'"L''z»N 

-Tl6V 

-t-  COS  a -(-  sin  a 

(4-18) 

lig  = IflcosL 


) *2  * (nsin  L ^ ^ tan  l]  6^^  - - Tj^V^C, 


* * ’’L^'^rN  ■ 'X  “ * 'y  “ 


(4-19) 


V / V 

- TT  ‘'n  - .-jf  j Oj.  . V^'m 


^ Z ‘ Z N “ \ ^ ^ z 


(4-20) 
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4.6  EXTENSION  OF  THE  LOCAL-LEVEL  ERROR  EQUATIONS  TO  THE 
ALTITUDE  DAMPED  CASE 

The  mixture  of  externally-measured  and  liiertially -derived  altitude 
which  occurs  In  Eq.  (4-12)  via  the  gain  constant  k fenders  the  altitude  channel 
stable  for  ic  > 2.  Note  that  this  removes  the  static  vertical  axis  Instability 
but,  in  the  absence  of  additional  feedback  signals  to  provide  damping  results 
in  a marginally-stable  altitude  loop.  This  additional  feedback  is  introduced 
into  the  mechanization  Eqs.  (4-1)  and  (4-2)  in  the  rhai^ner  shown  below  with 
the  altitude  damping  terms  expressed  in  north,  east,  down  coordinates. 


I (Vc>c  = * i («C.  - (-IC  * n)  X - Kj  - V ) * 


L»d 


d 

3t 


^'ec 


0 

0 

Ci(h-h^) 


(4-21) 

(4-22) 


The  equation  for  the  additional  damping  state,  a^  is; 


a^  Cg  (h 


h ) 


r 


(4-23) 


The  damping  required  to  establish  stability  margin  is  supplied  by  the  feedback 
constant  Cj(Ref.  12).  Second-order  damping  which  improves  the  low-frcquency 
error  behavior  is  provided  by  the  Cg  feedback. 

Changes  in  tlie  local-level,  wander-azimuth  erj-Or  equations  whicli 
result  from  the  perturbation  of  Eqs.  (4-21)  to  (4-23)  respectively,  are  given 
below.  Equation  (4 -12)  becomes; 


I 
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■ 'X*'^N  - (^ncosL  + -^j  6Vg  - kjV^g  + kj 
The  additional  terms  appear  in  Eq.  (4-17)  as: 


(4-24) 


V V 

6h  = - 6V2  + 6Rj^  + 6Rg  - Cj  (6h  - 6h^) 


(4-25) 


where  the  ext  ra  terms  due  to  the  altitude  clamping  have  been  underscored. 
The  damping  state  variable  error  equation  is: 


^ (6h  - 6h^) 


(4-26) 


These  error  equations  are  depicted  m Fii<.  1-1.  Note  that  the  solid  lines  of 
the  figure  correspond  to  the  undamped  Eqs.  (4-12)  and  (4-17). 


'^E  '>^N  (_ 

-K;  v^E  i' 


ACCEL£nO?'H‘"c=r 

Lt'.'EL  CP/ NA-r  L , 
velocity  EFpl'NS.  ' 
OnAVlTY  a\cmaly 


Vfj/R 


rn 


/p" 


I 


: UJ 


Figure  4-1  Damped  Allitude  Channel  Error  equation  Diagram 
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The  complete  set  of  error  propagation  relations  for  a velocity  and  altitude 
aided  local-level,  wander-azimuth  inertial  system  have  now  been  set  down.  They 
are  given  again  in  Table  4-2  for  the  convenience  of  the  reader.  Equation 
numbers  identify  the  portion  of  the  text  in  which  each  equation  is  originally 
stated.  The  following  points  are  noted  in  regard  to  these  equations. 

• The  equations  are  valid  for  any  combination  of  damping 

configurations  including  zero  damping;  there  are  no 
restrictions  on  the  values  of  ic,  kj,  k2>  CjandC2. 

Thus  analysis  of  a continuously  damped  INS  may  be  per- 
formed for  any  permutation  of  the  following  external  aid 
schemes: 

External  altitude  measurements 
External  velocity  measurements 
First  order  damping  (level  and/or  altitude  channels) 

Second  order  damping  (level  and/or  altitude  channels) 
Navigation  mode  gyrocompasslng 

• The  equations  may  easily  be  assembled  into  "state  space 
form",  namely 

X = Fx  + u (4-27; 

which  is  the  formulation  most  suited  for  covariance  error 
analysis. 

• This  set  of  equations  also  describes  error  behavior 
in  a north-slaved,  locally-level  INS  if  a is  set  to 
zero. 

• The  error  equations  of  a continuously-damped  iner- 
tial system  have  been  shown  to  be  the  same  for  both 
local-level  and  space-stable  coordinate  frame 
mechanizations  (Refs.  1,  13).  While  the  gyro  and 
accelerometer  error  models  differ  for  these  two 
mechanizations,  the  dynamics  of  the  error  propa- 
gation are  invariant  if  the  damping  is  implemented 
in  the  same  manner  for  both  meclianizations.  Con- 
sequently the  local-level  equations  may  be  modified 
to  be  suitable  for  space-stable  inertial  platform 
analysis. 
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• The  presence  of  the  gyro  torqulng  feedback  terms  in  the 
^ equations  (4-18  through  4-20)  results  in  additional 
terms  which  couple  .hem  with  the  velocity  equations 
(4-10_and  4-11).  Hence  damping  of  the  24  hour  dynam- 
ics {ili  equations)  links  the  earth-rate  (24  hour)  and 
Schuler  (84  minute)  loops. 

• The  Foucault  oscillatory  mode  (approximately  the  fre- 
quency difference  between  the  two  level-axis  Schuler- 
loop  frequencies)  which  is  manifest  as  amplitude  modu- 
lation of  the  velocity  and  position  errors  is  also  damped 
by  the  level  channel  velocity  damping  (kj).  For  a more 
complete  discussion  of  Foucault  mode  decay  character- 
istics see  p.  148  ff  of  Ref.  2.  The  topic  is  also  treated 
in  Refs.  3,  6,  and  11. 

• With  the  INS  natural  modes  damped  as  described  by  the 
equations  of  Table  4-2,  all  errors  except  those  rising 
from  the  polar  component  of  gyro  drift  rate  are  bounded. 
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- eVjj  - ♦ kj  ♦ a* 


■ _ ; ' - ■;■'  . - ' ‘ i ' ' 

..^.'  <4-M) 

- Cjlili  - *ig 

(4-ie) 

* ''jE*Z  ■ 

<4-lJ) 

~ ^ + kj  (eVj  ^ ■ ^N*Z  ' *'rS^ 

(4-14) 

V . V 

<4-ll) 

<oontimi*4  on  noxt  png*) 

■if  h; 


UHL  ■' 

*TT 
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APPENDIX  A 

A DERIVATION  OF  THE  NAVIGATION  ERROR  EQUATIONS* 

A derivation  of  the  navigation  error  equations  a^ich  follows  directly 
from  the  mechanization  equations  is  briefly  documented  here.  By  this  approach, 
errors  in  ground  speed  and  position  error  of  the  vehicle  as  seen  in  the  true 
frame  are  obtained  directly.  The  philosophical  approach  is  that  of  Ref.  2. 


A.  1 THE  MECHANIZATION  EQUATIONS 


The  navigation  mechanization  equations  derived  in  Ref.  2 are  repro- 
duced below: 


Pg(V^  = A +g(R)  - (o-'jg  H-n)  X V 


(A.  1-1) 


where 


Pg  ( R)  = Pg  ( R ) - a.'^g  X R 


^ " ‘*'  ES  ^ ^ 


(A.  1-2) 


Pg  ( ' ) = gf  ( ■ )g  = ^he  time  rate  of  change  of  (• ) as  seen  by  an 

observer  in  the  S frame 

^ ^ ~ ^ ^ ~ time  rate  of  change  of  (• ) as  seen  in  an  earth 

fixed  frame 

li  = vehicle  position  vector 

V = Pg  ( R ) = vehicle  velocity  in  an  earth  fixed  frame,  i.  e. , 
ground  speed" 


This  Appendix  has  been  extracted  from  Ref.  14. 
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n ■ angular  rate  of  earth  fixed  axes  with  respect  to  inertial 
space 

smgular  rate  of  S frame  w.  r.t.  inertial  space 

angular  rate  of  S frame  w.  r.t.  an  earth  fixed  frame 

non  gravitational  force  on  vehicle  (ideal  accelerometer 
output) 

g(R)  = plumb  bob  gravity  force  on  vehicle 

The  S (true)  frame  is  the  coordinate  frame  in  which  the  solution  to  the 
navigation  mechanization  equations  is  derived.  Though  usually  chosen  with 
some  good  engineering  justification,  the  S frame  is  not  unique.  The  mechani- 
zation equations  can  just  as  well  be  written  in  some  other  rotating  frame,  in 
which  case  they  would  have  the  form: 

= s + g-(i:'j^  + a)x  V 
and 

Pc(R)  = B 

In  the  sequel,  "C"  will  denote  the  computer  frame. 


(A. 1-3) 
(A. 1-4) 


CO 


IS 


CO 


ES  " 
X = 


A. 2 SOME  COMMENTS  ON  ERROR  ^\NALYSIS  PHILOSOPHY 

In  many  error  analyses  only  two  coordinate  systems  are  considered; 
the  S frame  in  wiiich  it  is  desired  to  mechanize  the  navigation  error  equations, 
and  the  frame  physically  instrumented  by  the  inertial  platform.  Though  not 
apparent. such  an  approach  can  lead  to  incorrect  definition  of  perturbation  (i.e., 
error)  quantities.  These  ambiguities  are  easily  resolved  by  tlie  introduction  of 
a third  coordinate  system,  namely  the  computer  frame.  All  errors  are  then 
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defined  with  respect  to  this  frame.  The  heuristic  reasoning  for  this  approach 
Txins  somewhat  like  this.  At  each  point  in  time  the  computer  may  be  viewed  as 
constructing  a true  coordinate  frame  at  its  computed  position.  It  then  determines 
the  angular  rate  of  this  coordinate  system  with  respect  to  Inertial  space  using 
both  its  computed  position  and  velocity.  This  is  the  computer  frame  of  Eq. 

(A.  1-3)  and  Is  a valid  frame  in  which  to  solve  the  mechanization  equations. 
Indeed,  this  is  exactly  what  happens.  The  computer  Integrates  the  mechaniza- 
tion equations  in  the  frame  defined  by  its  output.  Errors  In  this  mechanization 
arise  from  three  sources:  (1)  acceleration  has  been  measured  in  the  platform 
frame  and  not  the  computer  frame,  (2)  gravity  is  incorrectly  computed  since 
the  computer  frame  is  not  coincident  with  true  vehicle  position,  (3)  computed 
vehicle  velocity  does  not  equal  true  vehicle  velocity.  The  first  error  results 
from  angular  misalignment  of  the  platform  and  computer  frames  while  the 
second  and  third  errors  are  caused  by  relative  motion  between  the  computer 
and  true  frames. 

At  first  glance,  one  may  be  disturbed  that  no  error  arises  due  to 
incorrect  computation  of  the  computer  frame  angular  rate,  since  such  a term 
always  seems  to  be  present  when  referring  all  errors  to  the  true  (S)  frame. 

But  one  must  realize  that  the  computer  frame  is  entirely  defined  by  computed 
position  and  velocity.  There  is  no  error  in  the  state  of  this  frame.  If  desired 
it  could  be  realized  physically  by  constructing  an  S frame  at  the  computed 
position  and  rotating  at  the  computed  angular  rate.  Alternately,  one  may  say 
that  the  computer  makes  an  error  in  computing  the  angular  rate  of  the  true  (S) 
frame.  Thus  the  Coriolis  correction  applied  to  A+  g is  (^'jq+  H)  x ^ and  not 
(o.'jg  + fT)  X V.  But  this  Is  precisely  Eq.  (A.  1-3)  and  the  computer  does  indeed 
generate 


i 


r- 
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A. 3 THE  ERROR  EQUATIONS 


From  the  foregoing  discussion  the  computer  actually  mechanizes 

® ‘ ^IC  + ^ ^ 

(A.  3-1) 

and 

■ ^'ec  ^ 

(A.  3-2) 

where 

= computed  vehicle  ground  speed 

= computed  vehicle  position 

= accelerometer  outputs  as  interpreted  by  the  computer 

Let: 

= A + ^ 
= V + W 


g(R^)  = g + 3g  (A.  3-3) 

where  the  unsubscripted  variables  represent  true  quantities  and  the  5 terms 
represent  as  set  undefined  errors.  Putting  Eqs.  (A.  3-3)  in  (A.  3-1)  and 
subtracting  (A.  1-3)  yields 

V^(W)  - 5A  + Af  - (w  •+  f?)  X 3v  (A.  3-4) 

Likewise  putting  Eq.  (A.  3-3)  in  Eq.  (A.  3-2)  and  subtracting  Eq.  (A.  1-4) 

P^(5r)  ^ Zv  (A.  3-5) 


In  an  error  analysis  the  position  and  velocity  of  the  true  frame  are 
specified  (this  is  equivalent  to  specifying  the  veliicle  mission  profile).  Thus 
u;  and  a'  „ are  prescribed.  For  this  reason  the  differential  equations 

lo  h-o 


!i 


M 


A-4 


! p 
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characterizing  error  propagation  are  best  written  in  the  ”S"  frame.  The 
Impropriate  Coriolis  conversions  are: 

P^(^)  = Pg(6v)  + II>^g  X ^ (A. 3-6) 

and 

P^(^)  = Pg(^)+I)^gX  «R  (A. 3-7) 

Equation  (A. 3-6)  in  Eq.  (A.  3-4)  and  Eq.  (A. 3-7)  in  Eq.  (A.  3-9)  produces  the 
desired  final  relationships: 

Pg(3^)  = 5]^  + - (2:-jg  + 75)  X (A. 3-8) 

and 

Pg(^)  = 3v-L'ggX^  (A.  3-9) 

Equation  (A. 3-8)  describes  the  time  evolution  of  error  in  determining  vehicle 
velocity  with  respect  to  an  earth-fixed  frame  while  Eq.  (A.  3-9)  gives  the  time 
evolution  of  the  error  in  determining  vehicle  position. 

Equations  (A.  3-6)  and  (A.  3-9)  can  be  obtained  by  an  alternate  and 
instructive  route.  The  development  for  Eq.  (A.  3-8)  is  presented  here.  Apply- 
ing Coriolis'  law  to  P ^ (V^)  one  obtains: 

^'cs  ^ 

Eq.  (A.  3-1 0)  in  Eq.  (A.  3-1)  yields: 

Pg(?c)  = . g(R,g)  - . (T)  X 

Subtracting  Eq.  (A.  1 -3)  from  Eq.  (A.  3-11)  then  gives  Eq.  (A.  3-8). 

The  errors  6A  and  6g  must  now  be  determined.  Denoting  the  total 
accelerometer  error  by  u the  accelerometer  output  is: 

A-5 


(A. 3-10) 


(A. 3-11) 


i 
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= K + U (A. 3-12) 

M may  include  random  errors,  scale  factor  errors,  etc.  The  components  of 
Eq,  (A.  3-12)  which  are  available  in  platform  axes  are  taken  by  the  computer  to 
be  the  components  of  in  the  C frame.  Thus  the  vector  is  rotated  by  the 
computer  through  -5i,  the  small  angle  misalignment  between  computer  and 
platform  axes  to  become: 

Sp  = A-  0xA-^-  ^ X K+Ji  (A. 3-13) 

0 o 

It  follows  from  Eq.  (A.  3-3)  that: 

= M - X S.  (A.  3-14) 

Errors  in  determining  g include  errors  in  computing  plumb  bob  gravity  and  the 
computer's  lack  of  knowledge  of  vertical  deflections  and  gravity  anomaly.  At 
worst  the  error  in  computing  the  centripedal  term  in  g(R)  is  two  orders  of 
magnitude  less  than  that  obtained  in  computing  the  mass  attraction  gravitational 
force,  gj^.  Denoting  gravity  anomaly  and  vertical  deflections  by  ^ one  may 
then  write: 

^ ^ (A.  3-15) 

The  derivation  of  is  well  developed  in  Ref.  2 and  will  not  be  repeated  here. 
Likevnse,  the  differential  equation  governing  the  time  evolution  of  the  ii>  angle 
is  derived  in  Ref.  2.  The  complete  set  of  error  equations  is  then: 


Pg(^)  = ^ + - (Wjg  + fT)  X 3v 

(A. 3-16) 

Pg(5"R)  = 5v  - a-gg  X 55r 

(A. 3-17) 

P^(o)  = - Wjg  X t)  + f 

(A. 3-18) 

A-G 

[j 
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where  and  ^ are  defined  by  Eqs.  (A.  3-13)  and  (A.  3-14)  and  c is  the  total 

vector  gyro  drift  rate,  including  random  effects,  biases,  and  scale  factor 

2 

torquing  errors,  and  g and  g effects. 
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APPENDIX  B 

NAVIGATION  ERROR  EQUATIONS  EXPRESSED  IN  TERMS  OF 
PLATFORM  MISALIGNMENT  ANGLES 


As  was  observed  in  the  text  just  prior  to  Eq.  (2-13),  the  true  to  com- 
puter frame  misalignment,  is  a reference  frame-dependent  function  of  posi- 
tion error.  In  order  to  obtain  the  navigation  error  equations  in  terms  of  the 
^ (platform  to  true)  angle  misalignment  the  relation 

0 = ^ + 3^  (B-l) 


The  reference  frame  of  interest  is  that  of  a local-level,  north- pointing 
Hence  the  north,  east  and  down  components  of  6 (from  Ref.  2)  are: 


(cos  L)«X  = -pS 

(B-2) 

6T 

-6L  = - ^ 

(B-3) 

«Rj. 

- (sin  L)5\  = - -5 — tan  L 

K 

(B-4) 

with  derivatives: 


is  used, 
system. 


N 


R6R^  - R6r^ 

r2 


R6h^  - R6R^ 


R' 


(B-5) 


(B-G) 


B-l 
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tan  L + nSRg  L aec  L - R^'Rg  tan  L 


R" 


(3-7) 


A8  a consequence  of  Eqs.  (2-7)  and  (3-1)  of  the  text,  the  quantity  R is 


given  by: 


R = - V, 


(B-8) 


Substitution  of  Eqa.  (B-1)  Uirough  (3-4)  into  the  clamped  inertial  acceleration 
error  equations  (4-10),  (4-11)  and  (4-24)  gives: 


6R^ 


SR 


^ bySina  + -(A^  + g -^jV^)  + (A^^,  - kjVg)  tauL  ^ 
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^ Z ^ R ■ ■'■  ~W~  ■ IT 

+ (6h  - 6h^)  — ^ ~ ^2f*  cos  L + 

+ (Aj^  - Xj, 


Substitution  of  Eqs.  (B-'l^  through  (B-8)  into  the  >~j  equations 
through  (4-20)  gives: 
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(B-14) 


where  the  relation  for  the  latitude  rate, 


L = 


’N 

R 


(B-15) 


has  been  used. 

The  velocity  error  and  damping  state  equations  (4-13)  - (4-16),  (4-25) 
and  (4-26)  remain  unchanged.  Equations  (B-9)  through  (B-14)  m conjmiction 
with  Eqs.  (4-13)  - (4-16),  (4-25)  and  (4-26)  of  the  text  provide  the  complete 
error  dynamics  description  of  a local-level,  wander  azimuth  INS  mechaniza- 
tion in  terms  of  the  platform  tilt  error  angles. 


B-4 


THE  ANALYTIC  SCIENCES  CORPORATIC  N 


REFERENCES 


1.  Hutchinson,  C.  E.  and  Nash,  R.A.,  Jr.,  "Comparison  of  Error 
Propagation  in  Local-Level  and  Space-Stable  Inertial  Systems," 

IEEE  Transactions  on  Aerospace  and  Electronic  Systems,  Vol.  AES-7, 
No.  6,  November  1071. 

2.  Pinson,  J.C. , Inertial  Guidance  for  Cruise  Vehicles,  Chapter  4 of 
Guidance  and  Control  of  Aerospace  Vehicles,  C.T.  Leondes,  editor, 
McGraw-Hill  Book  Co. , 1963, 

3.  Pitman,  G.R.,  Inertial  Guidance,  Jolin  Wiley  and  Sons,  1962  (pp.  163ff) 

4.  Deleted 


5.  Heiskanen,  W.A.  and  Moritz,  H.,  Physical  Geodesy,  W.H.  Freeman 
and  Co. , 1966. 

6.  Nash,  R.A.  Jr.  and  Hutchinson,  C.E.,  "Altitude  Damping  of  Space 
Stable  Inertial  Navigation  Systems,”  IEEE  Transactions  on  Aerospace 
and  Electronic  Systems,  Vol.  AES-9,  No.  1,  January  1973. 

7.  See  Reference  2 or  3. 

8.  Organizational  Maintenance,  Integrated  Avionics  Systems  (for  A7D 
Aircraft),  Oklahoma  City  Air  Logistics  Center  (USAF),  Technical 
Order  1A-7D-2-18,  P.  5-9. 

9.  Du'oretzky,  L.H.  and  Edwards,  A.,  "Introduction  to  Doppler-Inertial 

System  Design,"  Journal  of  the  American  Rocket  Society,  December 
1959.  " 

1C.  Kayton,  M.  and  Fried,  W.  R.,  Avionics  Navigation  Systems,  John 

V/iley  and  Sons,  19G9. 

11.  Britting,  K.  R.  , Inertial  Navig.ation  System  Analysis,  Jolni  Wiley  and 

Sons,  1971,  pp.  83  ff,  p.  113. 


R-1 


THE  ANALYTIC  SCIENCES  CORPORATION 


12.  D'Appollto,  J.A.  and  Roy,  K.J.,  "Integrated  Navsat/Inertlal  Flight 
Test  Analysis",  Chapt.  2,  The  Analytic  Sciences  Corp.,  Report  No. 
AFAL-TR-74-56,  April  1973. 

13.  Nash,  R.A.  Jr.,  Levine,  S.A.  and  Roy,  K.J.,  "Error  Analysis  of 
^ace  Stable  Inertial  Navigation  Systems, " IEEE  Transactions  on 
Aerospace  and  Electronic  Systems,  Vol.  AES-7,  Ko.  4,  July  1971. 

14.  D'.^polito,  J.A. , "The  Evaluation  of  Kalman  Filter  Designs  for 
Multisensor  Integrated  Navigation  Systems,"  The  Analjdic  Sciences 
Corp.,  Report  No.  AFAL-TR-70-271,  January  1971. 


1 


f 


R-2 


